/*******************************************************************
 * Title: deskey.sc
 * Author: Brian Peck
 * Date: Spring 2011
 * Description: Specification model for DES key generator
 *******************************************************************/
#include <stdio.h>

import "i_sender";
import "i_receiver";
#define DE1 1
#define EN0 0

static unsigned short bytebit[8] = {
        0200, 0100, 040, 020, 010, 04, 02, 01 };

static unsigned long bigbyte[24] = {
        0x800000L,      0x400000L,      0x200000L,      0x100000L,
        0x80000L,       0x40000L,       0x20000L,       0x10000L,
        0x8000L,        0x4000L,        0x2000L,        0x1000L,
        0x800L,         0x400L,         0x200L,         0x100L,
        0x80L,          0x40L,          0x20L,          0x10L,
        0x8L,           0x4L,           0x2L,           0x1L };

static unsigned char pc1[56] = {
        56, 48, 40, 32, 24, 16,  8,      0, 57, 49, 41, 33, 25, 17,
         9,  1, 58, 50, 42, 34, 26,     18, 10,  2, 59, 51, 43, 35,
        62, 54, 46, 38, 30, 22, 14,      6, 61, 53, 45, 37, 29, 21,
        13,  5, 60, 52, 44, 36, 28,     20, 12,  4, 27, 19, 11,  3 };

static unsigned char totrot[16] = {
        1,2,4,6,8,10,12,14,15,17,19,21,23,25,27,28 };

static unsigned char pc2[48] = {
        13, 16, 10, 23,  0,  4,  2, 27, 14,  5, 20,  9,
        22, 18, 11,  3, 25,  7, 15,  6, 26, 19, 12,  1,
        40, 51, 30, 36, 46, 54, 29, 39, 50, 44, 32, 47,
        43, 48, 38, 55, 33, 52, 45, 41, 49, 35, 28, 31 };

behavior desKeyGen(i_receiver ir, i_sender is) 
{
  const char* bName = "desKeyGen";
  void main(void) {
    unsigned char key[8];
    short edf;
    unsigned int i,j,l,m,n;
    unsigned char pc1m[56], pcr[56];
    unsigned long kn[32];
    unsigned long *cook, *raw0, *raw1;
    unsigned long dough[32];
   

    //while (1) {
      
      printf("%s: key: ", bName);
      for (i = 0; i < 8; i++) { 
      ir.receive(key+i, sizeof(char));
      printf("%c   ", key[i]); }
      printf("\n");

      ir.receive(&edf, sizeof(short));
      printf("%s: edf: %d\n", bName, edf);

      // Generate DES key schedule
      for ( j = 0; j < 56; j++ ) {
        l = pc1[j];
        m = l & 07;
        pc1m[j] = (key[l >> 3] & bytebit[m]) ? 1 : 0;
      }
      for( i = 0; i < 16; i++ ) {
        if( edf == DE1 ) m = (15 - i) << 1;
        else m = i << 1;
        n = m + 1;
        kn[m] = kn[n] = 0L;
        for( j = 0; j < 28; j++ ) {
          l = j + totrot[i];
          if( l < 28 ) pcr[j] = pc1m[l];
          else pcr[j] = pc1m[l - 28];
        }
        for( j = 28; j < 56; j++ ) {
          l = j + totrot[i];
          if( l < 56 ) pcr[j] = pc1m[l];
          else pcr[j] = pc1m[l - 28];
        }
        for( j = 0; j < 24; j++ ) {
          if( pcr[pc2[j]] ) kn[m] |= bigbyte[j];
          if( pcr[pc2[j+24]] ) kn[n] |= bigbyte[j];
        }
      } // end for i

      raw1 = kn;
      cook = dough;

      for( i = 0; i < 16; i++, raw1++ ) {
        raw0 = raw1++;
        *cook    = (*raw0 & 0x00fc0000L) << 6;
        *cook   |= (*raw0 & 0x00000fc0L) << 10;
        *cook   |= (*raw1 & 0x00fc0000L) >> 10;
        *cook++ |= (*raw1 & 0x00000fc0L) >> 6;
        *cook    = (*raw0 & 0x0003f000L) << 12;
        *cook   |= (*raw0 & 0x0000003fL) << 16;
        *cook   |= (*raw1 & 0x0003f000L) >> 4;
        *cook++ |= (*raw1 & 0x0000003fL);
      } // end for i
      
     for (i=0; i<32; i++){
      is.send(dough+i, sizeof(long)); }
    // } // end while
  } // end main
}; // end behavior deskey
